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;ibJTR^iCT 


Various adaptive robot control algorithms have been 
studied in search of an al'prithm rhat is suitable for implemen- 
cation using loiv'-cost microprocessors. It is desired rhat the 
controller tracks a desired time-based trajectory as closely as 
possible over a wide range of manipulator motion and payloads. 

ji’irst, some adaptive control ali^orithms have been studied 
with respect to their tracking capability, :5ome basic works in 
the robot control area have been reviewed# a few new algorithms 
have been suggested and their critiques presented. In this work 
it is shown that# with simplified model# it is very difficult to 
achieve a ' guaranteed' control that can operate over wide range 
of motion and payloads. 

.V new discrete dynamic model has been derived for repre- 
sentation of robot. A computer situulation study has been con- 
ducted to evaluate the performance of the proposed model. The 
model shows good parameter convergence if there is no error in 
measurement. 

A similar model has been used in Computed Torque Adaptive 
Control ' Patnaik, 1987 , Comparison of the robot control strate- 
gies shows that the Computed Torque Adaptive Control is most 
robust algorithm in terms of stability. This algorithm has been 
recommended for implementation, a dedicated computer architec- 
ture has been proposed for it and the algorithm has been suitably 
restructured for parallel processing. 
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CiAAPTSR 1 


INTRODUCTION 


Industrial robots have evolved with the pressing need 
for increased productivity and delivery of end products of uni- 
fom quality. They are general purpose computer controlled 
manipulators playing important role in automation of industries. 

To accomplish a desired high precision task# one would 
like to serve the raanipvilator' s joint actuators such that the 
manipulator follows a desired path. The control problem of a 
manipulator can be divided into two coherent subproblems - the 
trajectory planning and the motion control. The motion control 
problem consists of obtaining dynamic models of the manipulator 
and using these models to determine control laws or strategies 
to achieve desired performance. The problem can also be refer- 
red to as ' trajectory- tracking problem*. 

1.1 CONVENTIONAL i^ioTION CONTROL: 

« 

The motion control can be classified into two major 
categories! 

(1) Joint motion control 

(2) Resolved motion control (Cartesian space control). 

1.1.1 JOINT x'lOTION control; 

The desired motion is specified by a time-based trajec- 
tory of the manipulator in joint coordinates. The control task 
is to track the trajectory so that the errors between the desired 
and actual joint positions are minimum. 



Most of the work in robot control area is bawed on joint 
motion control. A table loop-up method has been suggested by 
Albus# 1975 . It requires tremendous computer memory. It has 
been shown Hollerbach, 1980 that computing input generalized 
forces using recursive i^Jewton-fiuler equations is most efficient, 
but fast computer is needed to obtain satisfactory sampling 
frequency and further fast computation should use several CPUs 
uuh, Lin, 1982 . Ihe use of variable structure theory has been 
proposed in ioung, 1978 . Ihis method is diffic;ilt to imple- 
ment since exact determination of switching instances for the 
control input is difficult. Linear optimal control has been 
proposed in Kahn, Roth, 1971 , I'akegaki, Arimoto, 1981 , and 
Vukobratovic, 1983 , However, linearization over whole motion 
range is difficult and the errors caused due to linearization 
are difficult to compensate for. The computed torque technique 
has been discussed in Li:ih et.al., 1980 , L\:ih, 1983 and 
Asada , alotine, 1985 . They uses a structure identical to mani- 
pulator dynamics for generating the control inputs, and hence 
explicitly accounts for the nonlinear system dynamics. Imple- 
mentation of such a control scheme needs the dynamic parameters 
of the system, since very accurate measurement of these para- 
meters is not possible, a controller based on this method will 
not be able to minimize the tracking error due to parameter 
uncertainties and xinknown loads. 

1.1.2 RESOLVED MOTION CONTROL: 

Here, the desired motion is specified by a time -based 
trajectory of the manipulator in Cartesian space coordinates 
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(vorld coordinates). The control is applied to the joints so 
as to achieve the desired end-effector motion in world coordi- 
nates. 

The resolved motion schemes are proposed in Whitney, 
1969 , ijuh et. al., 1980 and Paul^. vvu, 1982. 

1.1.3 DlFPlCULTIEii Ih COiMVEiMTIOHAL APPROACH: 

These control algorithms are somevhat inadequate because 
they require accurate modeling of the am dynamics and neglect 
the changes of the load in a task cycle. The changes in the 
payload often are significant enough to render these strategies 
ineffective. 'The result is reduced servo response speed and 
damping, which limits the precision and speed of the end 
effector. Any significant gain in performance for tracking the 
desired trajectory as closely as possible over a wide range of 
manipulator motion and payloads require the consideration of 
adaptive control techniques. 


1,2 adaptive robot CONTROL - BASIC REVIEW: 

In general, an adaptive controller can be defined as a 
controller which has some way of generating informations regar- 
ding the system dynamics and then utilizing them for control 
purpose. Usually an adaptive controller employs the past sequ- 
ence of input and output data to gain knowledge about the system 
parameters. 

Recently# various adaptive control algorithms have been 
proposed. Dxibowsky, DesPorges# 1979 devised a Model Reference 
Adaptive Control (MRAC) law using the steepest descent method 
for a class of manipulators with counterbalances in order to 
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handle nonlinearities and payload* But they neglected coupling 
between joints of the manipulator and did not assure the conver- 
gence of their control law. Takegaki, Arimoto, 1981 developed 
MRAC which consists of a feedforward control to reduce the 
effects of the gravity force and a feedback control to compensate 
for position errors# speed errors and other disturbances. The 
control is based on Lyapunov direct method which ensures conver- 
gence of the control law under the assvimption of slowly time- 
varying dynamics or the manipulator. But, they assumed low speed 
motion to neglect Coriolis and centrifugal forces. 

Various self- tuning control strategies have been proposed 
which fit the input-output data of the system with an autoregres- 
sive model. Leininger# Wang, 1982 used pole- placement tech- 
nique, Koivo, Guo, 1983 used multivariable model based on LQG 
control approach, Liu, 1985 combined LUG control with pole- 
placement. Aoivo, 1985 and Leininger et.al., 1986 extended 
their respective algorithms for resolved motion control. All 
these methods neglect the coupling forces between the joints 
which may b6 severe for manipulators with rotary joints. 

adaptive Perturbation Control theory has been proposed 
by Lee, Chung, 1984 . This strategy may be more appropriate 
for various manipulators because it takes all the interaction 
forces between the joints into consideration. The Adaptive 
Perturbation Control is characterized by a feedforward compo- 
nent, which is the nominal torque, values, and a feedback compo- 
nent which is computed separately and simultaneously in parallel. 
The Adaptive Perturbation Control theory has also been used by 
Choi et.al., 1983 • Their adaptive regulation scheme is 
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devised based on the Lyapunov direct method# ’sdiich generates 
variational control that regulates the perturbation in the vici- 
nity of the desired trajectory, 'Ihese methods have to compute 
nominal torques and these torques cannot be computed exactly. 

The adaptive perturbation control is also extended to work as 
resolved-motion control Lee and Lee# 198 4 . 

Horowitz# Tomizuka# 1986 combined MRAC and PID control 
techniques. The design method presented by them is based on 
the hyper stability approach. The coupling among the joints and 
nonlinear terms are explicitly considered. 

i 

Patnaik, 1987 developed a new approach. Basec Computed 
Torque Technique is utilized to build the adaptive controller. 

The robot model assumed is nonlinear and represents the robot 
arm as closely as possible. 

1.3 IHj:- Pf;0BL:-H8 ^iBoOCIATIL'D va'Li HOTIUN CONTROL; 

Robot arm is highly nonlinear and multivariable system. 
There are interactions among the joints. Various models - 
linear and nonlinear# single-input- single-output and multi-input- 
muiti-output# have been proposed to achieve robot control. 

Most of the current industrial approaches to robot 
control probl^ treat each joint of the robot arm as a simple 
joint servomechanism. The servomechanism approach models the 
varying dynamics of a manipulator inadequately because it 
neglects the motion and configuration of the vhole am mechanism. 
The changes in the parameters of the robot sometimes are signi- 
ficant and they lead to degradation of perfomance in terms of 



speed and tracking accuracy or even failure of these simple 
control strategies. On the other hand, significant performance 
gain in robot airra control require the consideration of more 
efficient dynamic models, sophisticated control approaches and 
the use of dedicated computer architectures and parallel proces- 
sing techniques. 

1.4 OBJECTIVE OP THE THESIS: 

The objective of the present wrk is to study various 
adaptive control algorithms, in particular, study possibility 
or a simpler algorithm tiiat would control the robot arm so as 
to track the desired trajectory as closely as possible over a 
wide range manipulator motion and payloads. It is also desired 
to propose a dedicated computer architecture and parallel proces- 
sing techniviue that would do fast computations needed by a 
sophisticated control algorithm based on an efficient dynamic 
model. 

1.5 breakdown of chapters: 

In Chapter 2, various adaptive control algorithms are 
presented. Various cases are considered to highlight their 
advantages and disadvantages. Their perfoimiance is observed 
with computer simulation. 

Some basic works done in the adaptive robot control 
area are reviewed in Chapter 3. Some new algorithms are then 
proposed and their critiques are presented. Convergence and 
stability issues of the adaptive robot control algorithms are 
discussed. 
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In Chapter 4« firstly Computed Torque adaptive Control 
technique is revievaed, A new model is derived vhich can be 
utili'zed for robot control. The effects of measurement noise 
and effects of neglecting some system dynamic parameters from 
the model are also investigated. 

Chapter 5 provides implementation details of multi- 
processing architectiire, Ihe Compared Torque Adaptive Control 
algorithm is considered for implementation. 

Chapter 6 enlists the various conclusions drawn through 
discussion and simulation studies and leaves a note on the 
scope for further work. 
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SELl’‘~rUI^lN.;j CU2^TR0L 0? 3lS0 MODEL 


This chapter presents study of some commonly used self- 
tuning control algorithms. These algorithms or their variations 
are used tor the robot control problem described in Chapter 3. 

2 • X "• "i- Xi>» CUiNi ‘i.‘RvJ Li • 

In practice# a very coimaon situation is the control of 
sy.-', terns venose parameters are unknown. It thus becomes necessary 
to go through the steps of plant experiments# parameter estima- 
tion# computation of control strategies and implementation. 

This procedure is quite time consuming and tedious. 

Trorn a practical point of view# it is thus meaningful 
r.o consider control systems with unknown parameters. ITie plant 
parameters may be constant or time varying, i’or these systems# 
it is reasonable to look for strategies that will converge to 
the optimal or near optimal performance that could be derived if 
the system characteristics were knovTn. Such algorithms are 
called self- tuning or sel f- ad1 usting strategies, '.when the 
characteristics of the process (.system) are changing# the vjord 
•adaptive' is used. 

The regulators considered are described by the block 
diagram of Figure 2. 1, The regulator can be thought of as being 
composed of three parts* a parameter estimator# a controller 
and a third part which relates the controller parameters to the 
estimated parameters. 




. It is assvuned that the process to be controlled can 
be described' by the stochastic difference equation 

A(z“^) yCh) « z~^ u(lc - 1) + C(z e(k) (2.1 

I 

where u and y are scalar input and output signals and ie(k) J 
a disturbance which is a sequence of independent random vari- 
ables with zero mean, and d is the delay associated with the 
control input. A(z“^), BCz'b andCCz'^ are polynomials in 
the backward shift operator z"^ defined by 

-2 

A(z"^) » 1 + a^z' a^z" + 








C(Z m 1 + Cj^Z ^ -f GjZ“^ t* . . • -t- Cj^ Z ^ 

C 

It is to be noted that the polynomials A(z”*^) and C(z~^) 
start with 1 (coefficient of 2 ° is 1) and are called monic 
pol/nomials. 

'xhe firsc seep in self- tuning control algorithm is to 
estimate the plant transfer function based on input and output 
data, iwo scheuies are usually used in practice. i'hey are 
presented below. 


2, 2. 1 RECURiilVa least SQUARES (itLd) I 


Assume that the system can be modeled by the folloviing 
equation. 


aCz"^) y(k) « z~^ dCz*”^) u(k - 1} + f^k) ( 2.2) 

where (V\k) is a sequence of zero- mean white noise. 

The following recursive equations then are used to 
Identify the system parameters i^jung, Soderstrom, 198 3 . 


0(k) 

T (k) 


0(k - 1) + L(k) y(k) - o'^tk - 1) ^(k) 

T(k - 1) l(k) 

A r I'^^Ck) t (k - 1) l(k) 

^ T(k - 1) - u(k) l^'(k) i:'(k - 1) 


where 


© is the parameter vector given by 


© 


T 


Z' 



®2 




n 


a 


A 



(2.3) 


( 2.4) 


( 2 , 3 ) 


« « • 


e • • 


( 2 . 6 ) 



i * i, and i = 0,.,,,n^ being the estimated 

count;.erparts of a^^# i = and b^^, i = respec- 

tively and 

^ is a regression vector given by 

Jr.'^llc) =S - y (k - 1) - y - 2) - . . . ~ y(k - n) , 

uiK - d - 1), - ... - u(k - d - m - 1) C2.7) 


and A is a scalar forgetting factor used to discount old data. 
The range of A is between 0 and 1. To start the algorithm, the 
following initial conditions are used 

to) = i # large 

/ 

«s(o) = 0 

/ ' ..> ihe term y(k) - 6(k - 1) G(k) is referred to as 

,v’ ' 

'estimarion error' or 'filtering residual'. 


>. 2. 2 !<Ji.CUt<diV£ iiXTEdjJSD LJbrvST d'wU.'iddS (REL3) : 

i£’@tk) in eqn. (2.2) is a moving average process given 
by 


■ ^-(vVk) « G(z ^) e(k) 

-1 "“^c 

- (i r c^z T C^Z r ... 1- c„^z ) e(k) 

then the process equation becomes the same as given in eqn, ( 2, 1) , 
In this case, the coefficients of polynomial C need to be esti- 
mated along with those of a and B. 
befine 



r 





/ 





/ 



# • e 


• # ♦ 


• * • 


( >.8) 


aud 


^■^(k) = - 1) - ... - y(k - n) u(}c - d - 1) ... 

T / 

uCk - d - m - 1) eCk - 1) ... e(k - n ) (2,9) 

vhere 

e(j) is the estirriated value or e(j). 

ahen same set of equations (2. 3) -(2. 5) are used to esti- 
:aate the system parameters. 


, 3 WlisIjylUM VAt4l(-U'id£ (ilV) Cvk>i i'-ioi-i J 

in this section, Hinirnum Variance (MV) strategy is 
considered, ihe structure of the regulator is first described. 
Then its extension to servoproblem is discussed. 


’.3.1 M.V. kiidULalUR • 

uet the system to be controlled be given by eqn. (2.1). 
Then in M.V. control a cost function of the form 


a t y‘^(k) 


( 2 . 10 ) 


or 


V , » lim 

^ w 



( 2 . 11 ) 


is minimized to obtain the control input u(k) Astrom, 1970 . 
bet the control be computed from 


u(k) » - Y(k) 

F(z n 


( 2 . 12 ) 


where, 

a(z"^) i\(z*S 


P(z“^) 


(2.13) 



Furthermore, are solutions of the Jiophantaine 

e qua cion 

Ciz'b = -(z"^) ^\iz~h + G(z“-^) (2.14) 

— 1 — 1 — 1 

and ) and G(z ) are polynomials in z given by 

i'^(z »• i + Cj^Z 1* ... ■** 

-U"^) = ’■ ^ ® 

V; 

The orders of polynomial jpnd ar^_ n^ = ~ 

If d *= 0, Chen the solutions or the biophantine equation becomes 

s» 1 and z g(z *= C(z '^) - ^(z 

and the control law is simply given by 

u(k) . - . --^a -!! yu) (?..i5) 

z ^ dU n 

ahe seif- tuning control can be ootained in the following 
two ways. 

alqorithxn i: 

Jtep i: Assuming that the system is governed by eqn. (2.1), 

the parameters are identified using RELS method. 

step 2: iiJqns. (2.13) and (2.14) are solved with the estimated 

parameters to obtain the polynomials G(z ) and F(z ). 

Step 3: Control is computed using eqn. (2.12). 

Steps 1# 2 and 3 are repeated for each sampling period. 
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iJtep 1 * The parameters are identiried assuming that the system 
is governed by e.qii. ( J, 2 ) . 

Step 2: Kquations ( 2.13) and ( 2.14) are solved with 0{z~h = 1 

to obtain the polynomials ^ 3(2 ^) and ■&‘(z"’^), 

otep 31 Control is computed using eqn. (2.12). 

■iteps 1# 2 and 3 are repeated tor each sami:)ling period. 

Ihe iuC .aethod is used in .'ilgorithra 2, .-is a result, the 
estimated parameters can be biased if the polynomial G is not 1. 

• iowever# it nas been shown tnat if the parameters converge to 
some steady- state values* not necessarily to the actual ones* 
the control law obtained is in fact the minimum variance control 
law ristrom, nvittenmark* 1973 • 'This is the self-tuning property 
Thus* even if the process is governed by eqn, (2.1) and the 
control law is derived based on .CuC scheme eqns. (2.3), (2.4), 
(2,5) , the closed-loop system e>dniibits minimum variance property 
'Ihe following conditions, are necessary for successful 
application of the minimum variance control. 

(1) Ihe polynomial B has all zeros inside the unit circle* 
i.e., system is minimum phase. 

(2) The polynomial C has all zeros inside the unit circle. 

(3) Time delay of the system is known. 

It must be noted that if the system is non-minimum phase* 
the control strategy will still be minimum variance strategy. 

This strategy will* however* be so sensitive that the slightest 
variance will create an unstable closed-loop system. 



A self- tuner yihich can both eliminate disturbances and 
follow a command input can also be obtained using the basic mini- 
mum variance principle. 

Consider the system given in eqn, (2,1). Let 
a reference signal. Introducing a reference control signal 
Uj^(k) throagh 

“ dCz”^) u^(k - d- 1) (’.16) 

and subcracting this equation from eqn. (2.1) the following equa- 
tion is obtained 

A(a’'^) y(k) - yjj.(k) = 3(z”^) u(k - d - 1) - u^(k - d - 1) 

+ c(z“^) e(k) (2.17) 

The rl.V. controller for (2,17) is then given by, 

u(k) - u^(k) * - y(k) - y^(k) (2,18) 

^ F(z ^ 

where F and G are solutions of eqns, (2.13) and ( 2.14). 

Eliminating from eqn. (2.18), the control law can be 

written as 

-•1 ■**1 

^( 3 ^) » . y(]c) - y (k) + y„(k + d t 1) (2.19) 

F(z h ■ B(z ^ 

or when using the eqns. (2.13) and (2.14), 

•*1 ^ - 1 

u(]c> » - y(k) y (k + d + 1) (2.20) 

p(z“b 

The control law thus consists of two partsJ a feedback 
from the output error (2.19) or the output (2,20) and a feed- 

)m the reference value. This is illustrated in Figure 




Fig, 2.2: M.V. Servo Tracker, 


The closed loop system then is 


y(k) 


e(k) . y (k) 


( 2 . 21 ) 


where — ^ is a polynomial' of order d. Thus, the controller 
bCz"^) 

minimizes "the effect of disturbance and at the same time the 
system follows the reference value. 


2.4 POLYNOMIAL LINEAR QUADRATIC GAUSSIAN (LQG) REGULATOR: 

In this section, a polynomial approach is considered for 
LQG regulator. This approach is much simplified as compared to 
the state variable LQG controller whose stiructure is consider- 
ably more complex. In state variable LQG controller, the design 
calculations which are done in each step involve the solution of 
a Riccati equation or, equivalently, a spectral factorization 
[Astrom, Wittenmark, 1980]. 





2.4.1 LJG fORi^ULATIOi^ ; 


Let the system be described by eqn. ( 2. 1) . Then the 
following quadratic performance index is selected. 

J (k) ss p(z y(h f d' ) - Q(z y^(k) ^ u(k) ^ 

( 2 , 22 ) 

i .'(2 , l(z '^) and ii(z ■^) being polynomials in the back- 

ward shift operator given by 

iHz'h « 1 -r i- ... f p z P 

P 

» qo f ... + z ^ 

q 

-1 -1 ’^r 

R(z ) « ^1^ 

and d* = d + i 

The cost fxinction can be selected to specify a wide range 
of designs that result in desirable closed-loop behavior for diff- 
erent applications. For exoitple# by choosing p(z ) » j(z ) « 1 
and Riz*"^) s» r^ a polynomial tracker can be obtained. The cont- 
rolled output will then follow a delayed reference signal y^^Ck) , 
This is desirable in robot control applications. 

2. 4, 2 THE CONTROL STRATEGY: 

The optimal LQG control law is defined by the recursion 

T 

Piz'h y(k + d'/k) + ^ RCz'b u(k) - Q(z"^) y^(k) « 0 (2.23) 

.-7 "O 

where 

^ G^Cz"^) B(z“^) E'.(z“h 

y(k + j/k) « ■* + ' ■■ ■■" u(k - d’ + j) 

C(z ^) C(z h 


0 < j < d‘ 


(2.24) 



"•1 *^1 

Fj (z ) and <^^(2 ) are polynomials of degree j~l and 

n^^-l respectively. These polynomials are obtained as solutions 
of the biophantine equations 

r dj (z"^) « C(z”^) (2.25) 

for j « 1, 

A more explicit recursion for u(k) is found as follows 
uewis# 1936 . 

Using the definition of -(z”^) eqn, ( 2, ii) is rewritten 


3.S 

n 


% P. y(k -r d' - j/k) + ^ u(k) - Q(z"^) y (k) * 0 

4 — Q J 

(2.26) 


Defining new polynomials 


n 


-1 P -1 

G' (z ^) « i- Pj G^,^. (2 ) 

• j «o 


(2.27) 


n 




P. 3(2"^) F ^.^.Cz”-*-) z“^ f ^ C(z“^) a(z"b 


j»o 


d' -j 


( 2. 28) 


fiqn. (2,26) becomes 

F’(z“^) u(k) « - G'(z“^) y(k) + C(2”b Q(z“b yj.(k) (2.29) 


The polynomial LQG controller given by eqn, ( 2. 29) can be 
represented by the block diagram shown in Figure 2.3, 


2.4,3 THE ALGORlTHi'^: 

The stepwise algorithm is as follows. 

Polynomials P(z"^), g(z’^)# RCz'^ and system delay d. 


Data : 



aeutify the systiem pararne'cers using riiSijG ecxuations 


Step 1; 

j-cep 2: .Solve (2,25) for tf’j and 0 < j ^ d' . 

/ 

Gtep 3: aolve eqn, ( 2,24) for y(K j/k) for 0 < j d' , 

Step 4: .j's-; eqn. (2,23) to find control u(k), 

'i-he steps 1, 2* 3 and 4 are repeated for each sampling 

period, 

(1) This algoriuhra, though simpler than the state space formu- 
lation, requires a good deal of computation. The ntimber 
of computations increase with the degree of polynomials in 
the system, the delay d and the cost function, 

(2) Though the algorithm provides a wide flexibiliny in the 
choice of cost functions, one has to verify that the 
closed-loop system is suable. This obviously restricts 
choice of cost functions. 

2, 5 SEbP-TUiaNG CUi-lTROLLER BaSh-D Oh POLE- ZERO PLACih-lSNT; 

i'4.V, control suffers if the plant is non-minimum phase. 

The problem here is that Pi.v. strategies try to caiicel the non- 
minimum phase zeros with unstable poles of the controller, > 

Hence, M. V. regulators are highly sensitive to parameter fluc- 
tuations. 

Another practical difficulty which occurs in H.v. cont- 
rollers* is that large amplitude control signals are generated 
which can exceed the control limits, 'ibe hard limiters are 
introduced in such cases and this degrades the regulator response. 















i'’urther# M.V. controllers need to know the system time delay 
* a priori ' . 

Ihese difficulties con# however# be eliminated by use of 
the LQG control strategy, rhe self- tuning regulator based on the 
LlG formulation has the drav^ack of being more complicated than 
the A,V, self-tuning regulator. Tnc reason for this is that roo 
many design calculations are involved in each step, Ihe self- 
runers based on pole-aero place.aeno are much simpler to use, 
while at the same time less sensitive to parameter fluctuations. 


^.5.1 PkusLKH F0Ri4ULa.riDtt i-u'jJ COt^SIDiiR/VnOw ; 

Let the system be characterized by eqn. ( 2. 1) . 
The transfer function of the system is then 




ki£h 


where d* * d f 1 


( 2, 30) 


it is desired that the transfer function from command 
input y^. to the output is given by 




such that the closed-loop system is stable. 


(2.31) 


DESIGN considerations: 

Let the general regulator be described by 

R(z“^) u(k) » T(z"^) yj,(k) - 3(z'’^) y(k) (2.32) 

The closed- loop transfer function relating y to y^ is 


then given by# 



BS 


(2. 33) 


z 


'£B 


ji.R + z 



Here# the backward shire operator is omitted for brevity, 
ihe design problem is thus eqtdvalent to the algebraic 
problem of finding polynoadals R, b and T such that eqn. (2,3?) 
holds. It follows from eqn, (2, 3?) that the factors of B whicn 
are not also the factors of aiust be factors of 1. rhe poly~ 
nomial » can be factorized as 


£j s d'*' d" (i.34) 

where all the zeros of b'*’ are inside the unit circle and all the 
zeros of b” are outside the unit circle. 

a necessary condition for solvability of the servo pro- 
blem is thus that the specifications are such that 

ii a B b"* ' ( 2. 35) 

m m^ , V 03^ 

Since degree of is normally less than that of 
AR ♦ z BS, it is clear that there are factors in eqn. (2.31) 
which cancel, Ihis polynomial which cancels in theeright hand 
side of eqn, ( 2, 31) can be interpreted as the observer polynomial 
Aq a Strom, Wittenmark, 19@ , 

'Ihe block diagram of the closed- loop system is shown in 
i'igure 2,4. 'Ihe controller can be interpreted as being composed 
of a feedforward path with the transfer function T/R and a feed- 
back wpath with a transfer function -o/R. 



2. 5, 2 IWE algorithms: 


Algorithm i: 

Data : The polynomials and both with zeros inside 

unit circle# and 3,^ are given. 

Step l: Estimate the parameters or the model by least squares. 

Step 2: factor tlie polynomial a into s'*" and s”. 


Step 3i 


Solve the linear equation 

AR- + 3“ S » A A 

1 m. o 


- 1 

where# S and Rj, are polynomials in z vrith deg S 
deg A-l and deg = deg r deg - deg A, 


Step 4: Calculate the control signal from Ru s I'y^ - Sy 

with R = R-B^ and T » a_B_ . 

1 o 

The steps 1# 2, 3 and 4 are repeated at each sampling period. 


A special case of Algorithm 1 is obtained when all 
process zeros are well damped. It is then reasonable to have a 
pole-placement design where all the process zeros are cancelled 
with controller poles. Under tiiis hypothesis# the pole-placement 
procedure can be simplified. The corresponding self-tuning 
algorithm then becomes. 


Algorithm 2: 

Step i: Estimate the parameters of the model by least squares. 

Step 2: Determine the polynomials and S such that 

-d* 

AR- -tz 3 » A„a^. 

1 mo 



.-■cep 3* 


Use Che control law 


a Ty^ - sy 

where 

i' = 

o m 

ihe seeps 1# 2 and 3 are rejpeated for each sampling 

period. 

dince the controller poles here are same as ■the process 
zeros^ this algorithm is not suitable for non-minimiam phase 
systems. 


2,5.3 j/ULti diili!''i'lhG CuiNTHUi-iiiUiil 


■ihis is a special case of pole placement controller, 
here, closed-loop poles are determined from the open-loop poles 
by the relation. 


?i(z ) *• A( UZ ) 

m 

- 1 I - 2 
ss 1 -t ua- 2 T u a 


where 0 < u' < 1 



ihe choice of u will shift the open loop-poles towards 
more stable locations in closed loop. It is seen in Figure 2. 5. 

Ihe advantage here is that only one parameter u is 
needed to specify closeness of the closed-loop poles to the 
origin Ghosh ec.al., 19d4 . 


2,6 dUbF- TUNING 00i\l'R0Li..c;R: 

In this section Rroportional-plus- derivative-plus- 
integral tPlb) control using pole-placement technique is discussed. 




Open- loop 
poles P 


Closed- loop 
poles Pj^Q., 


Pig. 2 , 5 : Pole Shifting Controller. 

2.6.1 DIGITAL PID controller: 

An analog PID controller, used as a compensator, is 
depicted in Figure 2.6. The PID control algorithm in such a 
case has a general form 



Pig. 2.6: Analog PID Controller. 






ULil 

litS) 


( i.36) 


as 'k... r 77“ 3 k, 

Jtr" b i 


Discretizing eqn, (2,36) and putting it in the incremen- 

.tal form, the following equation is obtained Isermann, i9 ' 6 -d . 

\'2»S1 


u(k) a* u(k - 1) T (3^ + 


( ?.37> 


wnere, 




2k 


- k 




3 


D 


3 i‘ 

and 1 is the sampling interval. 

If set point signal is included only in integral 

term., a t'lD structure is obtained which avoids "set point and 
vierivative kick". That is, a sudden change in the output after 


fast change in the set point is reduced Isermann 
The structure so obtained is. 


, i9ai . 

H81 


u(k) » u(k - 1) i- a e(k) - y(k) 


( >. 38) 


where 


3(z^) » 0-(l-z^)(l - z ^) 

■ o 


a 


T k., 


0 


r 

£ 
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2 , 6.2 SELF-TUNING PID CONTROLLER: 

Let the SISO system to be controlled be given by 
A(z"^) y(k) =z~^ B(z"^) u(k) + A(z~^) T)(]c) 


where 7 ) is the measurement noise 

and the PID controller structure chosen be 

R(z~^) u(k) = a e(k) - 0 (z"^) y(k) (2.40 

where, 

R(z'^) . (1 - (1 T C2.41 

The block diagram of the controller is then shown in Figure 2 . 7 . 


PID CONTROLLER 





Pig. 2.72 Self- tuning PID Controller. 






if’rom i''igure 2,?# it is seen that the closed-loop transfer func- 
tion is given by. 


V Ck) ^ z'*'^ u 3(g 

^r^^^ R(z“'^) u. -h dCz"^) 


3-1 

Let the desired closed-loop transfer function be -r — , 

— I 

\jhere ) is the desired characteristic polynomial. 

equating the closed-loop transfer function with the 
desired one and manipulating iurtner, the following equation is 
obtained, 


/-ilZ ) 






1 - 



+ !'r' 




( 2 . 42 ) 


Looking at eqn, (2.42) it can be argued that instead 
of a parameter vector containing a^^’s and b^*s the following 
parameter vector can also be used 


3 ,. 


e 


u 


a 


u 


If the RL3 equations are now used for identification, 
the controller parameters are directly obtained. It is to be 
noted that the two-step procedure, that is, parameter estimation 
and control law design has been reduced to single one by suit- 
able plant reparametrization. -agorithms of this type are called 
'algorithms based on implicit identification'. 

If Aj^(z”^) * 1, the controller esdiibits deadbeat 
response. In this case, the estimation error is created directly 
comparing y(k) with its predicted value. Otherwise, it must be 

’filtered by z . -t'be filtering is done as shown in 

-1. - z-i 

i^igure 2.6. iMote that ytCz ) » ■ - 
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j 1 



Fig. ,2.8: Filtering. 

System to be controlled is augmented by G(z ) . Para- 
meter estimation is done for this system. Thus, the regression 
vector is 

= [x(X - 1), -xCk - 1 ), u(k - 1), u(k - 2)] 
where x(k) is calculated from 
x(k) * G(z”^) y{k) . 

The contix)! is desired such that y(k) follows the refer- 
ence yj.(k) . 

2.6.3 THE ALGORITHM; 

— 1 

Data : The polynomial A^Cz ) . 

Step i: CCz""^) is calculated from given A^(z ^) . 

x(k) is computed from measurement of y(k) . 


Step 2: 







step 3: Parameter estimation is done for the augmented system 

using IUjS method, 

.•itep 4: Control is computed using eqn, (2.40), 

Steps 2, 3 and 4 are rspeaued for each sample. 

since, all process seros are cancelled by the cont- 
roller, this scheme fails for non-minimum phase systems, 

>.7 SiMULailON STUDIES: 

Performance of the control strategies mentioned in the 
previous section has been studied through digital computer simu- 
lation. In particular, their reference tracking capabiliry has 
been investigated. 

3?or this purpose the P matrix in the system identifica- 
tion has been initialized to I where = 1000.0. nil the 
elements in parameter vector e are initialized to zero. Por 
simplicity, time invariant system equations have been selected 
for simulation studies. The forgetting factor k is chosen as 
1.0. 

iSloise of standard deviation 0.0015 has been introduced 
at the output. 

To start the algorithm only the parameter vector e is 
updated for the first few samples. During this period, a nominal 
control input has been applied no the system. The controller has 
been switched on after elements ox parameter matrix are non zero. 
This is done to avoid overflow due to division by zero. 



2.7.1 H.V. COwIRGL: 


The system to be controlled is represented by the foll- 
owizig difference equation, 

y(k) + 0.6 y(k-l) + 0.11 y(k-2) + 0.006 y(k-3) 

= utk-1) -r 0.5 u(k-i) + 0.05 u(k-3) 

Two cases have been studied. 

In the first case, the output is expected to follow 
reference signal which tovggles between two values. In the 
second case, the reference signal is a sinusoidal waveforro. 

Figure 2.9 shows that the output tracks the reference 
value very closely in both the cases. 

The system to be controlled is represented by the foll- 
owing difference equation. 

y(k) - 0.39 y(k-2) + 0.07 y(k-3) 

s= u(k~l) +0.5 u(k-2) + 0.06 u(k-3) 

sinusoidal input is used as a reference signal. 

It has been discussed that the controller acts as a 

tracker ifl.'(z )»Gi(z J*!, Three different values of 
— 1 

r(z ) are considered, 

(1) RCz^h « 0.0 

(2) RCz"^) « 0.2 

(3) RCz'^) « 0.9 

It can be seen from Figure 2,10 that when there is no 
penalty on control, i.e. when R(z ) *0.0, the LQG controller 



acts as an .'i.V. controller. Tracking accuracy degraJes the 
penalty on control is increased. 

»..7.3 POLE i-LAGEi^iJSiMT COLT'ROL: 

Ic has been discussed -chai: uhe pole shifting method 
offers a convenient way to decide closeness of che do sad- loop 
poles no origin. Only one parameter, u., is needed co be speci- 
fied. ttence, this approach is used in simulation studies, Three 
cases have been considered, 

11) The system to be controlled is 

y(k) -r 2, 4 y(k-l) t 1,91 y(k-- 2) t 0,504 y(k-3) 

ss u(k“l) -r 0,5 u(k- 2) 0.06 u(k-3) 

The system is minimum phase, rience Algorithm 2 is app- 
lied. Various polynomials in the algorithm are selected as 
follows. 

« 1 0.5 z“^ 

» 1.6 2 - 0,59 z ^ 

and u ■ « 0*6 

It can be seen from Figure 2.11 that the output; of the 
system tracks the reference signal. 

( 2) The system to be controlled is 
y(k) - 0,39 y(k-2) + 0.07 y(k-3) 

* u(k— 1) + 2.0 u(k— 2) f 0,75 u(k— 3) 

This is a non-minimum phase system. Algorithm 1 is 


applied with the following data 



a » C.6 

& » 1 - 0.66 a"^ 

i 

It is evident from figure 2,11 that the output tracks 
one reference signal in this case also, 

(3) I'he system no be controlled is 

y(k) -r 0.1 yCk-i) - 3.12 yCk-i) - 2.16 y(k-3) 

» uCk“l) f 2 u(k-2) f 0.75 u(k-3) 

i'he system is unstable as well as non'-rainiraurn phase. 
Algorithm 1 is applied with 

Cfc as 0.4 

as 1 + Z^f0,12z^ 

b - 1 - 0.84 

"'l 

rhe reference signal tracking is shown in Figure 2,11. 

1.7.4 PI D CONTROL: 

The system to be controlled is 

y(k) - y(k-l) + 0.477 y(k-2) * 0.9 y(k-l) - 0.7 u(k-2) 

The closed-loop poles are placed at 0.1 jr J 0,435. 

The tracking performance for square wave and sinusoidal 
reference signals is shown in Figure 2.12. 
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(c) 

Pig. 2.10: LQG Control 

(a) R(z”^) » 0.0 

, (b) R(z"^) = 0. 2 


(c) R(z“^) 


0.9, 
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’□ reference + octual 

(c) 


Fig, 2.11: Pole Placement Control 

(a) Case l: Stable, minimum phase system 

(b) Case 2: Stable, non-minimum phase 

system 

(c) Case 3: Unstable, non-minimxom phase 

system, 









CHAPTER 3 


ADAPTIVE CONTROL OF MAH I PUL AIDES BASED 0^ 
CENTRALIZED AND DECENTRALIZED MODELS 


Chapter 2 presented a summary of commonly used control 
algorithms. Application of these algorithms to the robot 
control problem is the prime concern of this chapter. 

The chapter is organiaed as follows. First the 
dynamic model of a manipulator is discussed. This is followed 
by some basic work carried but in this area. Next, some new 
algorithms are suggested and their critiques presented. Finally, 
convergence and stability issues of the robot control algorithms 
are discussed. 

3.1 DYNAWIIC MODEL OF THE I'lANIPULATOR: 

'A priori* information needed for control is a set of 
differential equations describing the dynamic behavior of a 
manipulator. In general, the Lagrange-Euler equation of motion 
for an n-jointed manipulator can be expressed in vector matrix 
notation as Lee, Chung, 1982 

D(q) S + H(q# ^ * (3.1) 

where q, ^ and *q are n-dimensional vectors signifying the joint 
position, velocity and acceleration, respectively. D(q) is an 
(n X n) symmetric matrix. It includes the acceleration related 
coefficients of the joints and the effects of link inertia, 

H(q# h) is an n-dimensional vector signifying Coriolis and 



centrifugal torques* G(<l) is an n- dimensional gravity vector. 
■Ihe n-dimensional vector > is the system input ( torques/ force s) . 

The dynamic equations of motion for a manipulator are 
^hi<^ly coupled and non-linear, ihe elements of D(q)# H(q, q) , 
.,-,G(q) contain trigonometric functions. Moreover, the parameter 
values vary with changes in positions and payloads. 

3 . 2 ADAP TI VE CO N TROL ; 

The non- adaptive control algorithms require accurate 
modeling of the arm dynamics and they neglect the changes of 
the load in a task cycle, ihese changes in the payload of the 
controlled system often are significant enough to render these 
control strategies ineffective. Any significant gain in perfor- 
mance for tracking the desired time^based trajectory over a wide 
range of manipulator motion and payloads require the consider- 
ation of adaptive control techniques. 

ihe adaptive control algorithms are much more complex 
in numerical sense than non-adaptive laws. Also, it is diffi- 
cult to prove the stability of the overall system Vukobratovic, 
et.al., 1985 , However, one has to resort to the adaptive 
control if robot works in unknown conditions. 

Almost all parameter estimation algorithms have been 
based on linear models. On the other hand, robot model is a 
highly nonlinear system, A theory vtiich is compatible with 
nonlinear robot system has been proposed Vukobratovic et.al., 
1985 in vhich a nonlinear discrete model is used. This model 
t]^ically consists of a very large ntiirtoer of parameters, ^or a 
six degree of freedom robot, there are more than two thousand 



scalar parameters, itoreover# one cannot use least squares 
algorithm since it would yield biased estimates. Extended 
least squares has to be resorted to. Even tbou^ tiiis model 
is likely to give superb control, it is just impossible to 
implement it using today' s VLSI technology. 

lienee, linear models vhich are approximations of the 
robot dynamic model are used in practice, with the linear 
models, the adaptive control strategies can be broadly classi- 
fied into two groups. 

Ihe centralized control structure is one in which the 
plant to be controlled (the robot arm) is considered as a 
unique multivariable system in viiich all the joint interactions 
are taken into account. In decentralized approach to control 
synthesis, the robot is regarded as a set of decoupled siib- 

4 

systems each corresponding to a separate joint and the coupling 
among them is neglected. 

^vdaptive Perturbation Control Lee, Chung, 1984 , 
Qoraputed Torque Adaptive Control Patnaik, 1987 are examples 
of centralized control, vhereas pole- placement self-tuning 
control Leininger, Wang, 1982 , PID self-tuner proposed in 
this chapter are examples of decentralized control approach, 

Ihe robot control strategies based on these two appro- 
aches are discussed svibsequently, 

3.3 POLE PLACEMENT SELF-TUNING (PPST) CONTROL OF iiANiPULATORS 
Leininger, Wang, 1982 : 

In planning., pole-placement strategy, the dynamic inter- 
actions among the joints are asstimed negligible. Hence, each 



joint is controlled independently. The mathematical model for 
each j^oint is assumed to be described by 

ACz”^) y(k) » B(z"^) u(k - d) + h(k - d) (3.2) 


where 

y is output (position) of the joint 
u is the control input (torque) 

h contains unmodelled effects such as gravity force and 
joint coupled interactions. 

It is assumed to be constant for a joint. The control input, 
u(k) , is calculated from 

G(z"^) u(k) « y^(k f d) - i?(z”^) y(k) (3.3) 

Substituting (3.3) into (3.2), the closed loop equation 
is obtained as 

A(z'’^) G(z''^) T z”*^ B(z*^) F(z“^) Y(k) = B(z”^)y^(k) (3.4) 


The constant h(t - k) is cancelled by incorporating it 


into the applied control. In assigning the closed^loop placbes, 

,-•1 •• 1 

the parameter f'(z~’‘’) and G(z ) can be obtained by solving t: 
following system characteristic equation. 


P 


A(z"S G(z‘‘b + 3(z"b F(z'^) « 

where is given by, 

Aj^(z“^) » (It* pj-z”^) (1 f ••• (3.6) 

where p,, i » l#.,.#m are desired closed-loop poles. The poly- 

4- I 

nomials A(z ■*■) and B(z ) used in eqn, (3.5) are first estimatec 



This algorithm is tested on a six joint JPL- Stanford 
manipulator, 

3.4 ADAPTIVE LINEAR CONTROLLER (ALC) FOR ROBOT MANIPULATORS 
Koivo# Guo, 1983 : 

The model of eqn. (3.1) is first linearized and then 
discretized by Euler's method. A multivariable discrete-time 
model is obtained in the form 

y(k) * T - 1) A^(k - 2) + a^u(k - 1) + 

B^(k - 2) + e(k) (3.7) 

where are (n x n) matrices, n is the nunber of joints. 

y(k) is an n-dimensional position vector (output) 
u(k) is an n-dimensional torque vector (input) 
a is an n-dimensional vector, 

Ay'i'UkiGrtESSI V£ MODELj FOR H/ikXPULA'IOk riOTxGiNi* 

The model obtained in eqn, (3,7) can be generalized as 
a multivariable givenday; equal; 

y;(k) ss A(z”^) >^:(k> + a(z”’^) u(k - d) i* h + e(k) (3,8) 

— 1 — 1 

where A(z ) and B(z ) are polynomial matrices defined by 

15 -n 

A(z'"^) = ^ ^ (^i.9) 

1 -1 “(n -1) 

BCz”'^) = ®o ®1^ -1 (3,10) 

a 

Note that A^, i » 1, ,.,,n^ and B^, i = 0, ,..,ng^-l are (n x n) 


matrices, and. 



h is a vector which includes the effects of gravitational 
forces. 

Uith this iftodel, the parameters can be estimated using 
multivariable least squares algorithm. 


3.4.2 SELF- TUNING ADAPTIVE CONTROLLER: 

The performance criterion for the system is chosen as 

I^(u) «B E y(k 1 - d) - y„(k + d) ^ + u(k) ^/’fCk - 1) 

(3.13 

where ^ is the regression vector and . ^ indicates the norm 

with weight R i.e. u ^ » u"^ R R is a positive semidefi- 
nite symmetric matrix, Q is a positive definite symmetric matrJ 
and describes the desired path vector as a sequence of 

discrete points. 'The expectation operation is conditioned on 
the available measurements upto and including time k-1. 

The problem is to minimize the performance criterion 
(3.11) while satisfying the following constraint equation 

ir(k) » e'^'(k) l(k - 1) 1 - e(k) ' (3.1' 


The control which minimizes (3.11) is determined by th 
following three equationsJ 

R u(k) + U J 2 (k d/k - 1) - :yj,(k + d) » (3,1 

t 

A Z' 

:£(k 1 - r/k - 1) » e-^(k - 1) J^(k - l + r/k - 1) (3.1 


J|(k - 1 r/k - 1) = 

y'^^^k - l),.,.#y^(k + r 





- 1 T r/k - 1) ....,^'^(k/k - 1), 
- n);/^u(k - d-J- r),.,.,u (k- d - n 




O 


3.3 


+ 1 + r) » 1 



where r = 0 » 1 , . , . , d 


a is the parameter matrix defined by 


© 






h 


ihe con-croi algox'ithm has been tried using simulation 
of a JPL-ocanford manipulator for the following two cases. 


(1) Separate Joint Control: 

it is assumed that interactions between the joints are 
small. ihe coupling terms in the autoregressive model of the 
manipulator are omitted and each joint is controlled independent 
or the other. 

(2) adaptive Control for Interacting Jointsi 

ihe problem is solved using multivariable autoregressive 
model (i.d). in order to restrict complexity of tiiis model, the 
variables of the model are decomposed into two groups on the 
basis or the mechanical structure of the manipulator, ihe coup- 
ling terms between the variables of the two groups are neglected 
For example, the matrices in eqn. (3.9) are written 
as 

^jl 

A » - - 

n 

where j « l,...,ng^ and A ^ and are both (-y x - 5 -) matrices. 



3.S CiNPRaLl^iLD ADAPTIVE PERTURBATION CONTROL (GAPC) 

Lee, Chimg, 1984 : 

Based on perturbation theory, (_Lee, Chung, 1984 (TV'"' 
proposed an adapcive control strategy vi^iich tracks a desired 
trajectory over a Ndde range or manipulator motions and pay- 
loads. -“daptive perturbation control takes ail the interactions 
among the various joints into coti si deration. Tlie control is 
based on linearised perturbation equation in the vicinity of a 
nominal tra j ectory. 

3.5.1 PSRTURbATiON E^UATiON OF I'iOTTON: 

T T T 

defining the state output vector as x » ^ q and ' 

the input vector as u » , eqn. (3,1) can be rewritten as, 

x(t) » J(x(t), u(t), t) (3.15) 

/ 

where 

x(t) u(t) R^, t f : X X 

and continuously differentiable, and n is the number of degree 
of freedom of the manipulator. 

with this formulation, the objective is to find a 
feedback control law u(t) » such that the closed loop 

control system j2^t) » J^t), t) is asymptotically 

stable and tracks a desired trajectory. 

Given a nominal trajectory, nominal torque Uj^(t) can 
be computed using nominal state (X^(t), Then, u^(t) and 
satisfy eqn. (3.15), or 

(x^(t) « 




(3,16) 



Linearizing the model of eqn, (3.15) about the nominal 
trajectory using 'Baylor's series expansion, and discretizing 
the • continuous time model, perturbation equation is obtained in 
the following form, 

x(k *<■ 1) » A(k) x(k) T L(k) u(k) (3.17) 

^vhere 2< * iS " “ U ~ L(k) and B(k) are (2n x 2n) 

and ( 2n X n) matrices respectively. VJith this model, 6n^ para- 
meters are identified. 

3.5.2 CONiROLbEH DESiGisi: 

The following performance criterion is selected. 

J (k) “ + 1) Q x(k + 1) ”i* u^(k) R u(k) (3.13) 

The optimal control input u(k) vhich minimizes J (k) 
while satisfying (3.17) is given by 

u(k) « - K(k) (3.19) 

where 

K(k) - 'R f B^(k) U B(k) B^(k) u A(k) (3.20) 

Ihe block diagram of the controller is shown in 
Figure 3. 1. 

Similar algorithm has been developed by 'Y.K, Choi et.al 
1985 vhere the joint interactions are taken into account. The 
scheme is devised based on the Lyapunov direct method vdiich 
generates a variational control that regulates the perturbation 
in the vicinity of a desired trajectory. 



Di sturbance 



Fig. 3*1: Adaptive Perturbation Control. 




both the algorithnis have been tested on PUMa manipu- 
lator through digital computer simulations. 

3.6 THS NbW ALGORIIHWS: 

..he work presented in the next three sections is 
Ccirried out eosencially in searcVi of a new algorithm that would 
prove an improvement over the algorithms basea on I'^ulti-Input 
rful ti-ourput (i41;'i0) models. Usually, the algorithms based on 
iiinO models are inefficient in txie sense tnat they involve too 
uiany computations per sample and it is difficult to partition 
these algorithms for multiprocessing. 

Following features are desired of the new algorithm: 

(1) it should be based on a simplified model, i4ultiprocessing, 
if required, should be easy to implements Arrangement of 
one processor per joint would be ideal, 

(2) ihe controller should be able to take the robot arm 
through the required trajectory at speeds comparable to 
those achieved by the algorithms vhich use AlbiO model, 

(3) ihe design should be such that the control strategy yields 
a reasonable performance over wide range of manipulator 
motions and payloads. 

(4) Ic should work on PUiMA manipulacors. 

Ihe algorithm may sacrifice some performance while achie- 
ving these requirements. Obviously, there is some trade-off 
between modeling and tracking accuracy. For simplified models, 
it is expected that the tracking accuracy will degrade. 
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iiDAir'l'lVE FID CONTROLLER (PlDC) 


central !_r.RARY- 

I :.T.. KANTUf^ 

"®*’***"‘* "*«>!? ' !»“ I I _ „ 

-iL’c. iVo. A1A4J.1.8.. 

i'OR ROBOT i'-LuXIPOLATOR: 


^..onsider a manipulator with degree of freedom equal to n 
Regarding PID controller, it is stated ‘Asada, Slotine, 
19ci5 rhat the torque for each joint can be computed by the 
relation 


t 

'it 

j j jo-’ 


j = X# . . . , n 


(3.21) 


where Cj - is the position error, and coefficients K , 

J j 

K„ and Kj. are positive and ” sufficieritly large". 

j j 

The above equation is e5Q)ected to control the raanipulaoor 
in point-to-point positional control. 

Effects of gravity are considered separately. At each 
step, identification and control computation is done without 
taking gravity into account. Ahile giving computed control to 
the manipulator, nominal value of the gravity at that position 
is added to it. 


3.7.1 THE •ALCORITHH : 


In this section, the proposed adaptive PID control algo- 
rithm is presented. This algorithm is a straightforward appli- 
cation of the algorithm discussed in Section 2,6. Each joint is 
considered as a separate entity. 

uet the model be described as. 


Aj(z“^) Yj (k) Uj (k) ■rAjCz”^) n^ (k) 


j «» 1, 


• • * f 


n 


i 


e 




(3. 22) 


where 



Uj (k) = ac time instant k 

Yj (k) « at time instant k. 

i‘he control is computed from 


Rj Cz"”^) utk) 
where 


Yj (k) 

J “ l#«»«<n 


(3. '2 3) 


Yrj the desired position of joint j at time 


and (k) « - Yj (k) 


The closed loop poles are placed at where 


mj 


(z~h 


— 1 — ) —% — a 

1 A , . 2 + A T , Z - T A , . Z + A . . Z 

mlj iTi2j m3j m4j 


( 3 . 24 ) 


The control method is applied to each joint. 


3.3 dEdERALIcTED SELf-TUNlNG CO.'4iROLLER (GSIU) wXTH POLE 
PLACEMENT: 


The algorithm proposed here uses combination of - Log 
and pole placement methods. 

Consider an n-jointed robot arm. For each joint j, 
j = l(...«n, let the model be given by 

AjCz”^) y^(k) » Uj(k) -r hj + ej(k) ( 3 . 25 ) 

where 

Yj and Uj are output and input of joint j 
ej is the disturbance term 

hj is the forcing terra v^ich includes the effects of the gravi- 


tational forces 



i r a^z 




xij (z ) 


, 1 

T ... -r 


-1 “(n -1) 

b„ ... ^ b _ z 

a 


is chs order o£ tdie model. 

ine oiCKward shift operator and the subscript j are 
omitted here on tor brevity and the following discussion applies 
to every joint, 

ihe difference equation model is ti-ien represented as 


Ay(k) » z”*^ tou(]c) -t h -t e(k} 


( 3 . ’ 6 ) 


Let the performance criterion be given by 


fj ‘PCyCk + d) - + ‘■^)) ^ + si* u(k) 


( 3 . ’ 7 ) 


where 

-n 

P - Po Pl^' + ... T z P 

P 

-i 

U* = 2 

q 

It has been shown [^Clarke, Gawthrop, 1975j tliat mini- 
mizing 1 and J » E jS^(k f d) will give same control law, where 

j2i(k f d) w P'y(k f d) - y^Ck -r d) t -j u(k) (3.28) 

and d * (q^/t>|jj)Q* 

Combining (3.26) and (3.28) 

^(k 1 - d) “ I ^^5c) + I' ♦ I d) + Q uCk) - P yj.(k + d) 


( \ . 7C^^ 





£m 


F t 



(3. 30) 


where i and 'J are polynomials in with the orders d-1 and 
n^-i respectively, 

lo minimize the performance criterion J, the control 
law uCk) should be chosen /uH. Liu, 1935 such that 

H u(k) -r Vi y(k) - F y^{k -r d) -f r = 0 (3,31) 


wnere 

ri » + j (3.32) 

r w FCz”^) h (3.33) 


me-chod of an line determination of the costing poly- 
nomials F and u is now presented according to closed-loop pole 
assigninent. 

Applying tne control law u(k) determined by eqn, (3,31) 
to system in eqn, (3,26) yields the closed-loop equation 

y(},) . ^ bp'T'aj ^3. 34) 

noose P and y such that 

BP + AQ » (3.35) 

where is a ore specified polynomial in z”^ and the orders of 
the polynomials P# Q and A^ are 

Hp * ng^-1, nq » n^-2, « 2n-l 


respectively 



3.3.1 .\i4G0RI'rtu''lJ 

ihe control algorithm can be sumiaarized as follows. 

bate • polynomial Initial values of polynomials 

1' and u m 

^tep li Estimate the polynoiiiials a, B and h using RLB. 

Jeep Calculate P» u from (3.35). 

vtep 3: Calculate ti, J, i’ and r from (3.30)# (3,32) and (3.33). 

Step 4 : Get coxitrol law u(k) from (3.31). 

Repeat steps 1# 2# 3 and 4 for each sampling interval. 

3,9 _jiiCS-« aR.-UjICBO ADAPl'iVii PBRl’URB.aTION CONTROL (DAPC) ! 

rhe basic idea of the perturbation control is presented 
in Section 3.5. 

ihe block diagram of decentralized control using per- 
turbation approach is shown in Figure 3.2. 

Bach joint of the manipulator is considered as a sepa- 
rate entity. ^ linear regression single input single output 
(oiov^) model is assumed for each joint. Xhe joint position is 
considered as output. Parameter estimation is done based on 

this model using Ri>3 method. 

experiments have been done with the following two 

control strategies mentioned in Chapter 2: 

(1) /i.v. control 

(2) Adaptive PlD control. 



56 



; the joint position 

Fig. 3.2: Decentralized Adaptive Perturbation Control. 

3.10 DIGITAL SIMULATION; 

The algorithms PIDC, GSTC and DAPC have been tested on 

PUMA-600 through digital simulation. 

In all the experiments, same trajectory has been used. 
The trajectory is generated using Paul's algorithm [r.P.C. Paul 

1981] . 

It is desired to move the robot arm from initial po^si- 
t^.on to final position where 

- [0° 45° 45°’ 45° -45° -180®]^ 

2^ » [90° -45° 135° 105° 15° -120°] 







The maxinavun velocity of each joint is specified by a 

vector V , 

~max 

“ dU°/sec 55°/ sec 120°/ sec 70°/ sec 60°/ sec 90°/ sec 

Tne time required to acquire maximum velocity starting , 
from zero velocity is set to 0,1 sec- for all joints. 

The sampling interval is selected to be 0,016 sec. 

It is observed that these algorithms ^ not give satisfac- 
tory performance. In fact, the parameters of the robot aarm do 
not converge and this results in failure of the control strategy, 

?.ll 

It is possible that the failure in PIDC, GSTC and DAPC 
algorithms were due to the following reasons: 

(1) i'jon-minimura phase behavior of a manipulator joint, 

^ i) in^erfect modeling of the manipulator. 

(5) inaccurate initialization. 

They are elaborated below. 

Cl) JNon-rainimum phase behavior: 

In Plb self-tuner# control parameters are calculated 
directly by using RLS method. Hence# nothing can be said about 
the system zeros. It has been seen in Chapter 2 that M.V. control 
and PID self- tuner fail to control a system which shows non- 
minimum phase behavior. Hence, if these strategies do not give 
satisfactory performance# it is justified to express a possibi- 
lity of system being non-minimum phase, in general# in the 
linearized model it is difficult to guarantee minimum phase 
behavior. Furthermore# in robotic systems# minimTim phase 



Gnt is satisfied in general only if the manipulator path 
it veil defined such that the dynamics# as seen at each Joint# 
are essentially inertial quantities within well defined ranges 
Leininger# -.ang# 19d2 • In the esiperiments# no care has been 
taken wnile planning the path so as to satisfy this requirement 
as this would be a stringent requirement on the path planner. 

In simulation of DAPC# it was indeed observed that the 
system shows non-minimum phase behavior. 

(2) Imperfect modeling of the manipalau>r: 

vf the six controllers discussed# PP3T# ALC# I-'IDC, 

J'ji’C, JAPd do not include terms for the interactions between the 
joints, riven chough the ejperiments with PIDC# GS'IG and DaPC ■ 
failecl on the PUii.-^ manipulator# PPST and ALC have been reported 
as successful on J Pn-atanford manipulator in Leininger# Wang# 
ija' and ivoivo# uuo, 1983 respectively. I'his# however, raises 
the possibility that there are heavy joint interactions in PUMA 
manipulators# particularly as the only controller known to have 
worxed on pUMa is CAPC vhich includes terms for interaction 
forces. 

Returning to the eqn. (3,1)# a typical i>-matrix of PUMA- 
600 is presented here, i'his is obtained for 

H a 0.14 44.9 45.2 44.9 -45.0 -176.8"^ 

^ * 6.35 6.53 8.59 2.0 2.8 —1,77 

2 » 258,0 -256,0 -73.9 528,4 418, 2 576,9 ^ 

The units of elements in jg# ^ and ^ are degrees, degrees/ 

2 

sec and. degrees/ sec respectively. 



374.79 

-32.24 

1.11 

1.49 

0. 232 

0.015 

-3 2. 24 

27.6 2 

3.676 

0.488 

0. 231 

-0.018 

1. 11 

3.676 

4.05 

0.52 

0. 23 

-0.02 

1,49 

• 0. 488 

0.52 

0.49 4 

0 

0,0264 

0. 232 

0. 231 

0. 23 

0 

0.3275 

0 

0.015 

-0.018 • 

-0,02 

0 . 0264 

0 

0.0375 

If the diagonal 

terms 

were predominant. 

it could have 


been argued that even if one neglects the off-diagonal terras^ 
it would not make any difference to the individual joints. How- 
ever, it is observed that there are high joint interactions in 
i'Ui''i---bOO. ?or example, effect on ^ snore than that of- 

d In other words, if effect on ^ is neglected, we have 

a uiodel in wtiich noise is dominant over the signal! 

(3) Inaccurate initialization: 

Ail the decentralized itiodeis are extremely sensitive to 
the Initial guess and this causes great difficulties in the 
starting of the algorithms. Consider a centralized control 
method, CnPC, in vhich an n- jointed robot arm is modeled with 
6n^ parameters. But in PIjX, a decentralized approach, only 4n 
parameters are used to model the robot arm. For a six jointed 
robot arm, these nuiribers are 216 and 24 respectively. With such 
a Sinai 1 niamber of parameters available to model the arm, it is 
extremely difficult to make an intelligent guess of the initial 
values in case of decentralized approach. Moreover, in MIMO 
model used for centralized control, parameters can be initialized 
using the robot dynamic model itself based on. the starting 



po3ition of the arm, There is no way to find relationship 
oetween parameters of decentralized control and the elements 

in the dynamic model of the rohot arm. 

The dynamic effects are to be estimated without using any know- 
ledge alx>ut system dynamics Vukobratovic et.al., 1985 . Thus, 
it is impossible to make a calculated guess of initial para- 
meters. £ven after initializing to some arbitrary values, the 
parameters are estimated using 'black box concept' without any 
knowledge of the system. Thus, if initial guess is far from 
actual parameters, the parameters may not converge in subsequent 
recursion. 

Thus, to achieve control using a decentralized model, 
many trial and error iterations have to be done. It calls for 
a good deal of experience and insight to choose initial values 
which will subsequently lead to current identification. 


3.12 UiSCdddlOUi 

rt>il decentralized controllers have a clear drawback in 
chat they neglect the joint interactions, apart from that, 
there are many vital points which deserve some discussion. 

The Minimiim Variance procedure is essentially a pole 
placing algorithm where the controller places poles/zeros to 
cancel system zeros/poles - i.e. the closed loop poles are placet 
at the origin. The resulting controller is, however, erratic ant 
often has excessively large amplitudes. This strategy cannot be 
applied if identified system zeros are outside the unit circle. 

Several problems have been reported with LQG control as 
applied to robotic manipulators. The control law can result in 



-a closfiu“loop unstable operation if actual robot pararoeters are 
car froiu the initial guess and/or are rapidly time-varying 
compared to adaption speed. i?urthermore. proper selection of 
ti and matrices compound the design problem Vukobratovic et. 
al.* 1965 . it has also been reported Koivo. Guo, 1933 that 
escimaced parameters change erratically during the first part 
of the trajectory producing abrupt variations in control signals 
and erratic movements of the robot arm. The results are obtained 
arter much trial and error iterations concerning initial guess 
and performance index weighting factors. Moreover, the results 
are obtained through simulation. In real situation, it remains 
to be seen how lauch erratic motions the actuators can cake. 

Also, the results obtained with trial and error are applicable 
Eor repetitive task in a well defined trajectory. These results 
do not generalize to a wide range of manipulator motions and 
payloads. 

The conclusions drawn for LuG approach practically hold 
for pole- zero placement control as well. The difference is that 
closed-loop poles are imposed instead of v«ighting matrices, 
Moreover, this procedure is described tor single input single 
output models only. 

with reference to the, algorithms discussed, tpsT will 
fail if controller polynomial G has zeros outside unit circle. 
Similarly, if matrix R has unstable eigen values, ALC will fail. 

The PID self tuning regulator has also been attempted 
by Vukobratovic et.al,, 1985 . They have reported that the 
behavior of the manipulator when starting the learning process 
depends mostly on the accuracy in initialization ox the pre-iictio: 



mo .id p-aro fieter 3» 'I'his accuracy determines the degree of erratic 
motions at start up. The convergence of parameter estimates and 
controller gains may not be achieved during the finite time over 
which aiotion calces place, Also* when the parameters change 
abruptly, the staoility of overall system may fail. 

•wiaptive Perturbation Control 'Lee, Chung, 1904 is a 
cont.ralized scheme based on i-iulti-Xnput Multi-Output (MIHO) 
model. xn tnia scheme, nominal corque values are computed on- 
line. ic has been reported by the authors that the performance 
of tne adapcive controller is quite sensitive to values of Q, R 
in eqn. (3,18). In general it is not easy to determine the 
proper values to acnieve better performance. It is also diffi- 
cult to figure out the correlations of these values with the 
overall performance of the controller especially in l 4IM0 system 
because of the complexity of tlie dynamic equations of the PUMA 
robot arm. ihere is one more problem vdth this aprjroach which 
is still unresolved. First, supx^ose that the paraiteters of a 
robotic system are exactly known. Ihen it is obvious that the 
identification of the linearized model is not necessary. On the 
other hand, if some parameters are mknown (for example, work 
piece mass and inertias), then che nominal control cannot be 
calculated exactly. Thus it is necessary to introduce an adap- 
tive algorithm at nominal level as well. The adaptive feed- 
forward compensation is not discussed in "Lee, Chung, 1984 and 
Choi et.al,, 1985 . 



CHAPTER 4 


ADAPTIVE CONTROL ANALYSIS 

In Chapter 3# it is seen that it is virtually impos- 
sible to design a controller based on SISO model with featiores 
mentioned in Section 3.6. Thus, one has to resort to a model 
which cakes joint interactions into account. 

in this chapter, first Computed Torque Adaptive Control 
Patnaik, 198? , which is essentially a centralized control 
strategy is presented. This model assumes availability of joint 
position and velocity measurements. Next, a model is derived 
which uses only position measurements. Lastly, the above two 
models are analysed. In the analysis, the effects of neglecting 
some system dynamic parameters, as well as, the effects of 
measurement noise on the performance of the adaptive controllers 
are discussed. 

4.1 COi-lP'JTED ADAPTIVE CONTROL ' Fatnaik, 1937 : 

The Computed Torque Adaptive Control algorithm is basic- 
ally an adaptive version of computed torque control which is 
also called the inverse problem. 

4.1.1 THE COi'lPtJTED 'TORwUE CONTROL 'Asada, Slotine, 1985 ' S 

The dynamic equations of a robot manipulator are given 
by, 

S'*" h) * 9^9) “ ^^*1) 


where. 
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• * 


^1% 


* 
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2 
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-‘a* -S) “ 


(4.2) 


^2«n 



. 2 
q« 

is an n x J matrix. 

Suppose the desired torque is computed from 

% ■" "" ’^ 2 ^% - - 3 ) ^ ••• ’ 

(4.3) 

where and k^ are diagonal gain matrices, 2^ a desired 
position vector and D_, ti and G are calculated or measured 
counterparts of D, d and G, respectively. 

Assuming that 

H^(q# q) » jriCq* q) 

Gjj(j[) « (4.6) 


(4. 4) 
( 4. 5) 


Eqns. (4.1) and (4.3) can be combined to obtain 



^^ 3 ) Sd “ 2 ^ - 2^ ^2% ■ 3 ) * 2 

je fining the position error vector 


Sq = 3d - 2 


(4.8) 


it in , (4,7) be come s 

^ r k, k u (4.9) 

— q 1 —q * ~q 

if k» Slid kj ere so chosen tliat the characteristic roots 
of eqn* (4«9) negative half of the ^-plane# then the 

error e will come down to 0 asymptotically, ihe convergence 

q 

relies on validity or eqns, (4.4), (4,5) and (4.6). 


4,1.2 ADAPi'IVi control: 

Due to parameter uncertainties, various frictional forces, 
modeling errors, etc., it is very difficult to satisfy eqns. 

(4. 4) -(4.6), Ihis difficulty is solved using adaptive control 
in which the dynamic parameters are identified on line. Let 

-1 (4.10) 

A sa D 



Discretizing eqn. (4.1) using backward rectangular rule, the 
following equation is obtained. 




Y(k - 1) + T A U(k - 1)' - 1' .g • '4 C Y^(k - 1) 


(4.13) 


where 



Y is the joint velocity (output) vector, 

U is the control (input) vector, 

T is the sampling period, 
and 

yi(k - 1) 

- 1) y^dc - 1) 

y^(k - 1) y^dc - 1) 
y^dc - 1) 

Y^(k - 1) »= . (4.14) 

y2(k - 1) y^^Ck - 1) 
y^(k - 1) 

# 

y„^k - 1) 

The control is computed from 

U(k) s ^1 + I + C Y^(k) (4.15) 

where a, B and C are obtained on-line using system identification. 
System Identifications 

To rind the parameters of eqn. (4.13) a multivariable 
version of Least Squares method has been used. Defining, 

A' • TA, a* - TB, C » TC (4.16) 


Eqn. (4.13) is rewritten as. 



■ I 

y(k) « Y(k - 1) •f ri.' U(k - 1) - B* - c* Y (k - 1) '? (k) 

"^O *** 

, X ^4,17) 

where _{k) is in V i) vecu>r representing the error in the mode- 


ling. 

Let 



I : A* : lj* : c* 

• • • 

(4.18) 


- /’(k - 1) : u^k - 1) : - 1 : - y'^ck - d 

* ♦ * ""C 

(4.19) 

Then, 

eqn, (4.17) can be written as 


Y(k) 

xs Jl(k) f ^(k) 

(4.20) 


The prediction equation is then given by 


Y(k/e) 

= e^' ^(k) ■ 

(4.21) 

Using 

eqns. (4.20) and (4,21), the parameter vector 

is update in 


a straightforward manner. 

4.1,3 DIGITAL COMPUTER SIMULATIOfiJ; 

The Computed Torque Adaptive Control algorithm has been 
tested for the first three joints of PUMA manipulator Patnaik, 

1987 . 

To test the algorithm on a six- jointed manipulator, 
siraularion of PUMA-600 robot arm has been done on DEC- 1090. 
Trajectory for the robot arm is planned using Paul's algorithm 
Paul, 1981 . Details of the trajectory are given in Section 3.10, 
The plots or errors between the desired and the actual 
joint positions as function of time are shown in Figxire 4.-1. It 
can be seen that the algorithm gives satisfactory performance 
for a six- joint robot arm. 
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It must be noted that the Computed Torque .\daptive 
Control algorithm is superior no the Centralized Adaptive Per- 
turbation Control in many respects. In Cection 3.12, it has 
been seen that the performance of Centralized Adaptive Perturb- 
ation Control is quite sensitive to values of ii and R matrices 
in eiqiis. (3»2_2^. in 'Computed Torque Adaptive Control, 

the paraifie ters can be initialized in a straiqhtiorvvard manner 
once the initial position of the robot is knovjn. iioreover, it 
does not have to compute nominal torque values, thus eliminatinq 
the need of adaptive feedforward compensatidjn. 

j.t, has betjn observed that the controller is able to take 
the robot arm through the trajectory in which the maximum linear 
speed is 4.25 m/s. This speed is higher than that reported else- 
where. However, tiiis speed is tested on computer simulation and 
it remains to be seen how much speed the actuators can tolerate, 
but as far as algorithm is concerned, it is robust enouah to 
achieve high speed tracking, ^ 

4.1.4 HKPARATION op ARl'^ AND WRIST: 

The main difficulty in implementing this algorithm is 
thar in involves a large amount of computation. natural way 
to overcome this difficulty is to neglect interactions between 
the joints to some extent. First step in this direction would 
be to decompose the robot model into two groups. The ‘arro* 

(first three joints) and the 'wrist' (last three joints) may be 
controlled independent of each other. Sucn a scheme has been 
used by ' Koivo, Guo, 198 3 and biu, Chen, 1986 . However, this 
decomposition is done on the basis of mechanical structure of the 
manipulator. It is possible in manipulators like JPL-Stanford 
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TIMC (SECOND) 

joint 1 + joint 2 O joint 3 

(a) 



(b) 

Tracking Error (maximiam linear speed 4.25 m/s) 

(a) First three joints 

(b) Last three joints 


Fig, 4, 2t 




in which presence of prismatic joint reduces the coupling terms 
between the variables of the two 'groups significantly. However, 
in case of manipulator, observation of D-matx'ix (shown in 

iection 3.l0j makes it clear that this kind of splitting is not 
possible. Hence, a full order model has to be used. 

4.2 i-.OdSL WIIH JOINT POSITIONS aS OUTPUT: 

It nas ueen seen riiat the algorithm basea on Computed 
xorgue .adaptive Control gives satisfactory pe'rformance when 
joint velocities are chosen as model output. 

However, in many practical applications, robotic systems 
are provided wdth only position sensors. It is then necessary 
to build a controller that would compute control input based on 
measurement of joint positions only. In this section, a model 
is derived with joint positions as output. The validity of this 
model is tested. 

4.2.1 DERIVATION OF THE MODEL: 

consider an n-jointed robot arm. Then the dynamic equa- 
tions of the arm are given by eqn. (4.1). Let 

A * D ^ 

^ as 4^ ^ S 

C a ^ 

Ihen# eqn- (4^1) becomes 
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(4. >2) 
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. 2 

Let _x (k) « q(k) and U(}c) « i^k) . 

Kqn. (4.22) is discretized by using forward Euler rule. 
The position vector at time k becomes 

_T(k) =» •“ i) T T J((k ■" 1) (4.2 3) 

and the velocity is given by 

,r(k) as T(k - 1) + T ^(k - 1) (4.24) 

The eqn, (4.22) is modified as, 

Yik) - ilik - 1) 1“ Y(k - 2) 

» A U(k - 2) - T^ b - C V(k - 2) f _(k) (4, 25) 

I 

where T is the sampling period, 

(k) is the modeling error and 



V(k) 


i.e. 


V(k) 


5l(k) 
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m 

q2^k) 

• 

qj^(k) 

q^^k) 



q^Ck) 

• 

q^Ck) 

• 

« 

q_^(k) 

• 


• 

# 
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y^(k 1* 1) - Yj^Ck) 

Yj^Ck + 1) - Yj^^k) >2^^ + 1) - y2^k) 



'y^tk + 1) - yj^(k)” 'yj^(Tc ■»■ 1) - y^(Tc) 
■ y 2 (k 1 * 1 ) - y 2 (k) ^ 


( 4 . 27 ; 


'y^Ck I- 1) - y2^k) ' YjjCk t 1) ~ 
y 3 ^k -r 1) - Yjik) ~ ^ 

♦ 

-y^(k . 1) - y„(W ^ 



Let 


> 


.A* = 

‘1‘ ^ 

(4.23) 

3' » 

1 

- T B 

(4.29) 

C ' « 

2 

- C 

(4.30) 


Then# sqa. (4,?. 5) b-.^comas 



= 2Y(k - 1) - Y(k - 2) f a' U(k - 2) + 3' t O' 

V(V. - 2) 


f _(k) 

(4.31) 


Lqn. (4.31) can be expressed as# 


Y(k) 

« e'^’ 'i'(k) + (k) 

(4.32) 

s 

r 


vvraere 
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■* ‘ 

(4,33) 


» Y^(k - 1) : - Y^'(k - 2) : i/'(k - 2) : 1 ; 



- 2) 

(4.34) 


ihe predictiou equation is 

y(k/d) « ^Ck) , (4.35) 

It is to be noted that V(k) can be calculated from the 
joint position measurements. However# if the joint velocity 
measurements are available# they can directly be used tor calcu- 
lation of _y(k) . 

Open loop system identification has been performed to 
confirm validity of this model. The RLS method has been used to 
identify the parameter matrix of three jointed PUMA- 560 through 
simulation. It has been seen that system identification is major 



bottle-neck of the adaptive control schemes in the sense that 
if pardiiaters of the system are identified properly# design of 
a control strategy is comparatively easier. 

ihe simulation results are presented in Figure 4.3. 

I'he plots of some of the actual parameters and identified para- 
meters are .snowi. 'ihe plotted parameters are elements of the 
matrices -3# P and u and their identified counterparts# where# 

a (4.36) 

0 » G (4.37) 

It can be seen that the identified parameters track the 
actual parameters of the model# proving validity of this model, 
ftith knowledge of these identified parameters# any of the tech- 
niques discussed in Chapter 2 can be successfully applied to 
achieve control. Obviously# the .algorithm developed in Chapter I 
will then have to be reconstructed to work on fdXi''lo system. The 
control part is not tested, 

4. 3 s.FFfi.CT OF h*a3UREi4EiNT xn10I3£: 

To test how the model derived in the previous section 
will work under noisy conditions# measurement noise is added to 
the output. Under this condition eqn. (4.31) is no longer valid# 
and modifications are required in the governing equation. 

Consider the model derived in Section 4, 2. The model 
(4.31) is reproduced for two jointed robot arm for simplicity. 
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Fig. 4.3: Plots Comparing Actual Parameters with Those 

Identified Using Model (4.31) 

(a),(b),(c) - Some elements of the inertia- 
matrix D 

(d) - An element of vector Q 

(e) / (f) ^ (g)/ (h) , (i) -.some elements of 

matrix P 


f 
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f n* U -f B* 


y/k) 


y^Ck-l) 

y2(k-i) 


y^ (k- 2) 
y.>{k-2) 


yj^{k-i) - y (k-2) ^ 

C * - 

^ ^ y]^(k-l) - y^{k- 2 ) y2(k-l) - y2(k-2) 

y^Ck-l) - y2(k-2)” ^ 

(4.33) 


If there is measurement error, then the measured output 
vector will be i:'(k) where 


y, (k) t e. (k) 

Y’ (k) » ^ ^ 

y2(k) + e.^lk) 

Ihen, eqn, (4,33) gets modified, to 


(4.39) 


yj^(k) f ej^(k) yi(k-l) ■r.e.(k-l) 

y2(k) T e2(k) y2(k-l) + e2(k-l) 


y,(k-2) i- e,(k-2) 

^ + A' U + B* 

y 2 (k- 2 ) -r e 2 (k- 2 ) 


"y^(k-l) + ej^(k-l) - y^(k-2) 

'y^(k-l) i- e^(k-l) - y^(k-2) 

■e -j 

'y2(k-l) + e2(k-l) - y2(k-2) 

”y2(k-l) T e2(k-l) - y2(k-2) 


e3^(k-2)' 

(k- 2) ” 
e 2 (k"“ 2) 
e2(k- 2) ^ 

( 4, 40) 


It must be noted that the actual output itself is not 
available for measurement. Hence, the regression vector used in 
identification itself is corrupted with measurement error. 
Furthermore, the error forms a moving average process and it 
contains nonlinear temms. It is clear that the estimated 



p-arai-neters will be incorrect if identification is done based 
on I'lijo . method. 

4:.xperiinent nas been conducted through computer simulation 
CO invest-igute che effects of measurement error. A noise of zero 
uieun and a standard deviation of 0.001 rad. is introduced as 
measurement error. The results are presented in ^itpare 4.4. 

'ihe plots of some of the actual parameters anl the ijuncified 
parameters in presence of measurement error are sho-wn. The plot- 
ced elements are elements or matrix D and matrix ? given by eqn. 
14.36) and their identified counterparts. 

it is seen that the identified parameters do not track 
tne actual ones, in fact, in presence of measurement error, the 
identifier benaves abruptly. 

The measurement error analysis has been done for the 
model with joint positions as output. The conclusion, however, 
ia valid for the model with velocities. as output also. 

4.3.1 MODEL REFERENCE TECHNIQUE: 

One way to eliminate the effects of measurement error is 
to use iTKPdel reference' technique for system identification. 

Figure 4.5 explains this approach. The method is des” 
cribed by Landau, 1976 , In the figure, M(0) represents a 
reference model of the system, same control input is applied to 
the system and the model, y^is the measured output of the system 
and y is output of the model. For identification of the system 
“arameters, measured output from the system is compared tc that 
f the model and model parameters are updated until the differ- 
nee between the two outputs cannot be further improved. It has 
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'ig. 4,4: Plots Illustrating Effect of Measurement Noise 

on Identification of Parameters 
(a),(b),(c) - Some elements of inertia- 

matrix D 

(d) / (e) t (f) , (g) , (h)- Some elements of matrix P 
(i) - Magnified version of 

plot (c) 




Pig. 4 . 5 : The Model Reference Technique. 


been shown that this method assures an asymptotic unbiased 
parameter estimation in the presence of noise obscured measure- 
ments [Landau, 1976]. This is true for single input- single out- 
put systems as well as multivariable systems. 

Thus, it is seen that the RLS method do not lead to 
correct estimates unless the output Y(k) is directly measurable 
and noise- free. Otherwise the model reference technique may be 
used. In most of the expensive robot manipulators, the measure- 
ment of joint coordinates can be considered as noise-free. Joint 
coordinate sensors are roost often high precision and high quality 
digital encoders. However, they have to be tested frequently 
for accuracy. 






4.4 n.FFh.CT3 OF UNi40DELED DliNAMICS: 

!t aoins -iv-'.teiTi dynamic parameters are neglected while 
inodelinq the robot arm, it will contribute to the equation 
error. .ne efrects of system dynamics are obviously non-white, 
inc- a stiiiivitSsl parameters can then be biased and the controller 
it, liKaly to tail. 

in oection 4.2, a model of n- jointed robot arm is deri- 
ved wi tn pojjition as output. Comparing this model with the 
lineariiieci model C 3. ) ootained by i^oivo, Cuo, lQcs3 , the 

following equations are obtained. 


a m ii • 

^ — 

A ^ a 21 

,A ^ — I 


- 0 

» a* 

«k - 5ik.> 

f ^ 

Thus# it can be seen that model O.’?*) neglects the 

Coriolis and centrifugal effects. 

open loop Identification of PUi4A-560 has been simulated 

using model (3.'^). since no term in robot dynamics " see eqn, 

(3,1) involve derivative of torque input, is assumed to be 

zero. Aj are initialized to 21 and-l respectively, a and 

1 * / 

are initialized appropriately using known values of gravity 
vector and inertia matrix. 

Since matrix is needed to model the inertia terms, 
it is reasonable to eaqject that the matrices and vdll be 



updated so as to account for Coriolis and centrifugal effects. 
Under this assumption, identified matrix will completely 
represent the inertia terms in eqn, (3.1). 

me simulation results are presented in figure 4 . 6 . 
ihe plots ot some of the actual parameters (elements of D 
inacrix) and their identified counterparts are shown. 

At is seen tnat the parameters identified using model 
( ) do not track the actual parameters, -^s a result, the 
controller based on this iiiodel may not be satisfactory. 

4*3 Cu Is CL U 3X0K s 

In this chapter. Computed Torque Adaptive Control has 
b*r*en investigated. A new model is derived which uses only joint 
position measurements as model output to identify the parameters, 
it has been shown that if the measurements are not noise- free, 
the parameters will not be idencified correctly. In such cases, 
use of toodel reference technique is suggested, 

it is also concluded that tlie identified parameters are 
going to be biased if some system dynamic parameters are neglec- 
ted. nowever, this scheme, may work in closed loop. 3ut to 
what extent it will work remains to be seen. . 

i’rora discussion in Chapter 3 and Chapter 4, it can be 
seen that Computed Torque Adaptive Control is superior to all 
other algorithms. This algorithm is recommended for implementa- 
tion. iMote that, a controller based on the modified iriodel (with 
positd.on as output) will also work as good as computed- torque 
adaptive control. 
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CHAPTER 


i 


l/iPLEMlia^TAlIOK: 

this chdpter discusses iniplementation details of Adap- 
tive Con.puted Torque Control Patnaik, 1987 . Identification 
aii.i contiol algorithm is first presented from a different view- 
point so as to ease subsequent discussions. Itien two ways in 
which multii^ recessing can be achieved are proposed. 

5.1 IDE.'.TI?ICATI0N; 

The basic algorithm of system identification using RLS 
method is given by eqns. ,(2. 3)# (2, 4). and ( 2.5). Ihe algorithm 
is applied to model (4.20) where 0 and are given by eqns. 
(4.18) and (4,19) respectively. It must be noted that eqn, 
i4.20) represents a multivariable model. The parameter 9 in 
eqn. (4,20) is a matrix and no more a vector. Hence all the 
iU i equations presented in Section 2, 2 have been modified appro- 
priately. 

This algorithm can be rewritten in a number of steps. 

The step-by-step version of the algorithm is presented for a 
six-joint robot by the following equations. It is to be no.-ced 
tnat 

Y(k) is a (6 X 1) vector 
0(k) is a (34 X 6) matrix 
J(k) is a (34 X 1) vector 
P(k) is a (34 X 34) matrix. 



step U _eCk) « J,(k) 

eCk) is a (6x1) vector. 

3t:ep I* ® ^-'ik-l) ^’(k) 

'7 

r'rfj is a (34 X 1) vector* 

step i! 'xiiii:-'!!' » i'^(k) 

■x'Si'ijr’ is a scalar, 
x'hen# __ 

■£my K + TEAP 

step 4: L(k) * PHX/T£;4P 

ij(k) is a (34 x 1) vector. 

Step 51 SL = 

EL is (34 X 6) matrix. 

Step 6: s(k) » 9(k-l) t EL 

Step 7:i) Stril » L(k) (Piil)^ 

sPHI is ( 34 X 34) matrix, 

ii) P(k) « p(k-i) - LPHI 

iii) P(k) » P(k)/A 

It is to be noted that step 7 involves (34 x 34) matrices, 
'i'aking advantage of the fact that they are symnietrical, only 
elements in upper or lower triangle of the matrix are computed 
and the rest are obtained at the cost of a requisite number of 
transfer operations. 

Table 5.1 shows the number of computations needed in 
each step. 



Table 5,1 




Hul ti plication s 

Additions 

Btep 

1 

204 

204 

'•Step 

2 

1156 

1122 

otep 

3 

34 

34 

Btep 

4 

34 

- 

Step 

5 

204 

- 

Step 

6 

- 

204 

Step 

7 - i 

595 

- 


ii 


595 


iii 

595 

- 

Total 

283 2 

2159 
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Control 

is computed from eqn, (4,15). 

In eqn, (4. 15) # 


the parameters a, B, C are involved# whereas idenrified para- 
meters are h* » Ta, fl* * TB and C* » TC. Hence# multiplying 
(4.15) by T# the sampling period# following equation is obtained. 

vm) a.' U(k) « T ■ ^ 1* ^2^3d 

This equation is used for the control computation. 

The control computation involves (6 x 6) matrix inversion. 
Using Gaussian elimination technique for matrix inversion, appro- 
ximately 500 multiplications and 500 additions are required for 




cor-al control computation, ihe computations may, however, be 
reduced by the use of pivoting technique as in Lee, Chting, 1984 
iTie sampling frequency is to be maintained at 60 Hz. 
Thus, all the computations must be done within 16 ms so as to 
meet this requirement. 

3 O. a1 1 LC ILii^L 1 

r'rom the above discussions it is clear that a large 
amount of computation is involved and the need for multiproces- 
sing is obvious, one way to tackle this problem is* to use a 
super-mini computer which can compute at very high speed. How- 
ever# this approach is not cost effective, and the use of low 
cost microprocessors is advocated. However, a single micro- 

I 

processor will not be able to handle the job and hence more than 
one processor has to work together. What is desired in this 
case is not a general purpose parallel architecture, but a dedi- 
cated architecture that will act as a fast controller for the 
robotic system. 

For implementations of centralized adaptive controllers, 
two different type of architectures can be used. They are 
(1) Array processing and (2) Pipelining, 

5.3.1 ARRAY processing: 

Considering the total number of arithmetic operations 
needed to be done in 16 ms and assioming typical instruction 

timings of nuLcroprocessors, it can be seen that about 5 to 8 

{ 

processors have to be present in the array. In the identifica- 
tion algorithm, there are six rows in most of the matrix 



computations. Hence# to use six processors for identification 
part is a natural choice. If six processors are used for iden- 
tification and one for control computation# then it demands 
that one unit of computation (defined as one multiplication and 
one addition) is done in 25 to 30 |is. Suitable microprocessor 
can be selected to satisfy this requirement, 

AS control computations can be done within 16 ms# a 
separate processor can be used for this purpose, as soon as 
©(k)# the parameter matrix# is computed by the identifier# cont- 
roller can start computations based on itw For this reason# 
only identifier architecture is discussed here. 

The Architecture of -Multiprocessing System: 

Ihe architecture of the system is shown in Figure 5,1. 
The array processor is a synchronous parallel computer with 
multiple arithmetic logic units (-ALUs)# called the Processing 
Elements (PEs)# that can operate in parallel. By replication 
of .\oUs one can achieve the spatial parallelism. The PEs are 
synchronized to perform the same function at the same time. 
Scaler and control type instructions are directly executed in 
Control Unit (CU) , Each PE consists of an /UiU vdth registers 
and a local memory. 

The architecture is essentially 'single Instruction 
stream-Hultiple Data streme' ~SIMD ‘ like. In simd architecture, 
vector instructions are broadcast to the PEs for distributed 
execution over different component operands fetched directly 
from the local meraoriee. Instruction fetch and decode is done 










by CU, The PEs are passive devices without instruction decoding 
capabilities. 

A slighr variation of this scheme is proposed here. The 
steps given in Section 5.1 can be grouped into different sets. 
One set essentially requires that during the execution of that 
set each PE can work individually without talking to the CU. 
j-he actual program for each sot of execution may well be replic- 
ated in each PS. The al-gorithm can then proceed via a series of 
start and stop signals between CU and the PEs. This is similar 
to the microprograiiuciing concept in which one macro-instruction 
causes execution of a set of micro-instructions. 

The saving in broadcast time# so obtained# is achieved 
at the cost of excess memory. It is to be noted that this opti- 
mization is possible only because it is going to be a dedicated 
system. 

Ihe Piul ciprocessing .algorithm: 

Notation: Let x be a vector or a matrix. Then 

denotes part of x that is processed by and is stored in its 
local memory. Tnen# the algorithm is optimized for parallel 
computation (i;^ as follows. 

Jet 1 : dU broadcasts ^(k) # 

fetches / 

PEj^ computes tk) # step 1 completed. 

computes Pdl^ i ^ elements each 
> except PEg which computes 4 elements, step t 
; completed. 

computes TEnip^ » 'i!(k) t dealer 



cet 2 : 


oer 3 : 


; product is partially computed by each PE, Each PE 

i uses part of f(k) and computed part of PHI, 

returns TEMP^ to GU, 

CU computes ‘IS^P and broadcasts 

6 

Tli’iP and X ; TErlP = a + 1 TEMP, 

i 

; step 3 completed 

i'^i coaiputes (k) = Piil^/TSMP and 

returns in to CU. ; step 4 comi:ileted. 


CU broadcasts U(k) ; It is 

; preferred to broadcast u (k) rather than e(k) 
f for step 5. Otherwise it would demand many 
/ transfers of elements of EL to do steps 6 and- 7 
; efficiently. 

i T 

computes = e^^Ck) L (k) } 

i step 5 completed, 

r T 

t rij, computes (k) » b^Ck-l) -t* 


^i * 


f step 6 completed. 

T 


computes LPrii^ = ^'^^i ' 

f stepf^ii) completed. 

Transfers of LPHI elements. 

P^(k-l) - LPHI^ 

computes ^ • 


/ Each PL computes approximately 100 elements 
i of Pj_. 

; Transfer of calculated elements of P to 
; other triangle. 

End of Recursion, 


!t 4 : 



5.3.2 pipelining; 


Pipelining offers an economical way to realize parall- 
elism. To achieve pipelining, the input task (process) is sub- 
divided into a sequence of subtasks# each of which can be 
executed by a specialized hardware stage that operates concur- 
ren'cly with other stages in the pipeline. Successive tasks are 
streamed into the pipe and get executed in an overlapped fashion 
at the sub task level, 

Figure 5.2 explains this approach. With respect to the 

figure# each module in the architecture does the required compu- 

u 

tations in 16 ms. dach module is either a Von Ne^ann machine 
(a single CPU) or an array processor as described in the pre- 
vious section. 

deferring back to the step-by-step algorithm given in 
jection 5,1# Jtep i is done by one processor. Step 2 is done ' 
by two (or at the most three) processors. It starts concurrently 
with Step 1, Steins 3# 4# 5 and 6 are done by one processor. 

:top 7 is done by two (or at the most three) processors. It 
starts concurrently with step 5. 

now’ many processors one should use per module primarily 
depends upon the computation speed of the available processors, 
une observation must be made here. The control to be 
applied at k will be computed using the identified parameters 
of the robot a few (say# n) sastiples before. This phenomenon is 
explained in Figure 5,3. in the pipeline architecture proposed# 

N is equal to 3. 
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Fig, 5.3 Pipelining with N « 4. 

This phenomenon has been simulated on DEC-1090. Exper- 
iments have been conducted on PUMA-600 through simulation for 
N » 3, 4, 5, 6, 7. 

With N a 3/ 4, 5 satisfactory tracking has been obtained 
for the trajectories in vhich the end effector moves with a 
linear speed upto 1,25 m/s. As ^ increases# the tracking accu- 
racy degrades# and at N = 6 and 7 it fails to track the desired 
trajectory. Figure 5.4 shows the tracking performance for N » 3 

Experiments with variation in the speed of tracking show 
that at high speeds (above 3.5 m/s) tracking accuracy degrades 
even with N s 2. This obviously restricts use of pipelining at 
hi^ speeds. 



POSITfON ERROR (RADIAN) 






The robot parameters vary vdth time. As N increases, 
the controller gets the parameters which are farther away from 
actual parameters. Ihe same is true if the speed is increased. 
Of course, if the parameters of robot change very slowly in a 
treijectory, the performance will not be significantly affected 
by w . 

Ji-t muse be noted rhat parting Adaptive Computed- Torque 
Control algorirhm in the architecture proposed, changes ^the 
algorithm itself. For example, the equarions e_(h) sa(^k) - 
^(k) and l- 'HI « 'i'(k) now become ^(k) * j^_|k) - 

9^(k-5) ’i‘(k) and PHI » P(X“3) i'(k) respectively. ihis is equi- 
valent no introducing a delay in the feedback path of the closed 
loop system. The experiments show that the closed loop can 
accommodate this delay to some extent. 

Figure 5.5 shows computations of the modified algorithm 
tnat would foe done at instant k. It is to be noted that Figure 
5.2 is no more applicable as can be seen in the previous para- 
graph. 

From the above discussion one may feel that, a scheme, 
in ^^ich the controller parameters are calculated each sample 
instant, whereas the identifier updates the parameters after 
each N samples will also work. At each sample instant, the 
controller takes the up-to-date measurements but uses old para- 
meter values. Here, the sampling frequency used by the cont- 
roller is still 60 Hz vdiich is well above natural resonant 
frequency of the robot. This will reduce the number of proce- 
ssors to be used in the pipeline. 




Fig* 5^52 Pipelining ; Computations at k. 










ihouM-h this seems highly desirable,, it must be noted 
inctc this is equivalent to the reduction of sampling rate of 
tnc i<Jt.nr„_-.i_4. by a factor of u, in e^qjeriments through simu- 
lation, it turned out to be unsuccessful, 

-i similar experience is also noted in Koivo, Guo, 1983 
vnere tne luthors suggested that the choice of the sampling 
rate should oa no less than 60 Hz to achieve a sufficiently 
.^.r.ooth control, 

3.3,3 GaHi'A ii OOH UF ARRAY r'RuCi.... aldG RlPHijIHIRG: 

wi early, pipelining snould not be used vhere fast arm 
iiiovemenc are involved, Ihe method vdll fail for the reasons 
cLiscuE;jed, nowever, for low and medium speed operations, pipe- 
lined architecture has many desirable features. 

xne design of multiprocessor system is modular in this 
case. If a module fails to give satisfactory data processing 
speed, it can always be augmented with one rrore processor. In 
array processor, whole parallel algorithm will have to be 
rt: scheduled. 

In array processing, one has to resort tx) very fast 
processors such that the condition of using six PEs is met. One 
can easily think of the complications arising in architecture 
and algorithm if one adds one more PE, 

if the control algorithm is modified in future, the 
change can be easily implemented in pipelined architecture, where 
as array processing architecture might have to go through major 
reshuffle. 



Ihe pipelined architecture can thus be attractive for 
low and medium speed applications. Hovreveri array processing 
architecture is recommended here aince it gives better perfor- 
mance in terms of speed and tracking accuracy, though it is 
likely to be costlier and complex in terras of design. 



CHAPTER 6 


CQRCLUSlO^jS 


In this thesis^ the robot control problem is studied 
from various angles. Home o£ the conclusions drawn from the 
study are presented here. The discussion is concluded with a 
few suggestions for further work. 

6,1 GENERAL CONCLUSIONS: 

i'rom the discussion and simulation studies in the pre- 
vious chapters# the following general comments can be made. 

(1) The non-adaptive controllers are not suitable for wide 
range of manipulator motions and payloads, 

(2) The decentralized approach to robot arm adaptive control 
treats each joint of dne robot arm as a simple joint 
servo-mechanism. The approach neglects the coupling 
forces between the joints which may be severe for mani- 
pulators with rotary joints, 

(?) Performance of the controllers depend significantly on 
values to which control parameters are initialized. In 
most of the algorithms# initialization has to be done 
by trial and error. It is also difficult to figure put 
the correlations of these values with overall i^erfor- 
raance of the controller, 

(4) Linearized models# in general, are not guaranteed to 

show minimum phase' behavior. Minimum phase requirement 
is satisfied only if the manipulator path is well planned. 
However# non-minimum phase behavior can be 



LQG control or with pole- placement. This again involves 
careful selection of control polynomials. 

(5) Computed Torque Adaptive Controller is most robust of the 
algorithms discussed in terms of stability and tracking 
accuracy. In this algorithm, the parameter matrix can be 
inicialized in the easiest way using initial position of 
the robot arm, 

(5) v model is derived which utilizes only position measure- 
ments, It is observed that system parameters can be 
identified using this model, ^^.ny standard control appro- 
ach can then be applied. 

(7) If there is measurement error, the robot control algo- 
rithm rails if method is used to estimate idle para- 
meters. 

(d) if some system dynainic parameters are neglected from the 
iiodel, identified parameters are biased. 

(y) Iwo dedicated computer architectures have been proposed 
to implement Computed lorque <idaptive Control algorithm, 
-‘•■‘ipelined architecture introduces delay in the feedback 
path or the closed-loop system. For better performance, 
array processor is recoinmended. 

6,2 dCui-d FOR FURTHlilR WORxs 

The work in the thesis is digital computer simulation 
oriented, dowever, need for more theoretical work is emphasized 
here, stability and convergence of the robot, control algorithms 
may be analysed in more details. But it must be cautioned that 
in this problem, it is very difficult to prove stability of the 
overall system. 



The Computed Torque Adaptive Control gives good results 
at least in computer simulation. It may be implemented using 
proposed array processing architecture* 
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APPEiMDIX I 


LINK P.\Ri!UMETERS AND MASS PROPERTIES OP PUMA 560 ROBOT 

The liak parameters associated with the first three 
joiucs of the PUMa 560 robot arm are given below in a tabular 
form 


u oint 
rmaiber (i) 

% 

in degrees 

u-i 

in degrees 

^i 

in meters 

<^1 

in meters 

1 

-160 to t160 

-90 

0 

0 

2 

-225 to t‘45 

0 

0. 432 

0.149 5 

3 

-45 to t'225 

90 

0 

0,0 


The mass properties are specified as follows^ 
1^ is the inertia matrix for i joint. Then 

0 0 
0 

yy 

0 


1 . 

ixx 


0 

0 


I. 

lyy 


^izz 


diag. = 

'0.0071, 

0.0267, 0.0267 

kg-meter" 

diag. 1 , ~ 

0. 1000, 

0.7300, O.B025 

> 

kg- me ter' 

diag. 1 , = 

o 

« 

O 

0.2160, 0. 2245 

kg-meter^ 


1%. yj,. 

i^) is a position vector 


th 


mas 


s of link i with respect to the i coordinate system. 




Sj »» 0.0, 0.0, 0.073 ^ meter 

- T 

3^ = -0.432, 0.0, 0,0 meter 

T 

Sj » 0.0, 0.0, 0.1 meter 

. - til 

in^ is the mass or x joint 

= I, >7 kg, m, » 15.97 kg, » 11,36 kg. 



APPENDIX II 


LINK PARAMETERS AND M/VS3 PROPERTIES OF PUMA 600 ROBOT 


The link parameters associated with the six joints of 
the PUMA 600 robot arm are given below. 


u'oiiit 

numoer 

Ai 

(i) . - 

in oegrees 

'•u , 

1 

in degrees 

^i 

in meters 

■^i 

in meters 

1 

-ioO to 

tIoO 

-90 

0 

0 

2 

-225 to 

t45 

0 

0.86 

0, 25 

i 

- 45 to 

1*225 

90 

1 

o 

• 

o 

0 

4 

-110 to 

1*170 

-90 

0 

0,86 

5 

-100 to 

1-100 

90 

0 

0 

o 

-256 to 

"f 2b6 

0 

0 

0, 3 


j.he .'ns3s properties 

are specified as follows: 


is 

tin 

the inertia matrix for i joint. 

Then, 



^ixx 

0 

0 



X . S 

i 

0 

X. 

lyy 

0 




0 

0 

1. 

xzz 



didvj. 

=* 

4. 5 

0,56 

) 

kg-meter 


diag. 

1^ 10#S 

35*1 

26.9 

kg- meter ^ 


diag. 

» 14,1 

14,1 

0.74 

2 

kg-meter 




diag, ■ 0.09 

0. 

06 

0.09 kg-meter^ 

diag. I- = 0.006 

0. 

009 

0.006 kg-meter^ 

diag. = 0, 29 

0. 

29 

0.0061. kg-meter^ 

Yi. 

•z 

i) 

a position 

vector of the centre 

o:: rnass of link i wirh 

re 

fSiDect 

to the i^ 

coordinate system. 

s ^ 0 0 


0.15 

’ iTieter 


« -0.43 0 


0 

meter 


3 ^ as ^ 0 0 


0. 43 

meter 


** 0 **0*03 


0 

meter 


3. « 0*006 0 


0 

meter 


= 0 0 


-0.15 

meter 


"til 

is the mass of i 

joint 



s= 49.9 kg 

^2 

= 109 

, 0 kg 

» 57.0 kg 

» 13. 3 kg 

m- 

:> 

“ 6,5 

kg 

“ 9 . ^ kg . 
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